def 测量点的三维坐标:
    加载标定图片
    标定，获取焦距f
    获取畸变参数
    获取光轴畸变参数,基线长度b
    while 1:
        读取当前摄像头画面
        去畸变
        光轴矫正
        获取所求点在左相机图像中的位置(x1,y1)
        获取所求点在右相机图像中的位置(x2,y2)
        点到相机平面的距离z=b*f/(x1-x2)
        获取点在左相机坐标系下的x坐标,x=z*(x1-光心横坐标)/f
        获取点在左相机坐标系下的y坐标,y=z*(y1-光心纵坐标)/f
